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Abstract — This paper introduces a novel feedback-control 
based particle filter for the solution of the filtering problem 
with data association uncertainty. The particle filter is referred 
to as the joint probabilistic data association-feedback particle 
filter (JPDA-FPF). 

The JPDA-FPF is based on the feedback particle filter 
introduced in our earlier papers [f7], [16]. The remarkable 
conclusion of our paper is that the JPDA-FPF algorithm retains 
the innovation error-based feedback structure of the feedback 
particle filter, even with data association uncertainty in the 
general nonlinear case. The theoretical results are illustrated 
with the aid of two numerical example problems drawn from 
multiple target tracking applications. 

I. INTRODUCTION 

Filtering with data association uncertainty is important to 
a number of applications, including, air and missile defense 
systems, air traffic surveillance, weather surveillance, ground 
mapping, geophysical surveys, remote sensing, autonomous 
navigation and robotics [1], [3]. In each of these applications, 
there exists data association uncertainty in the sense that one 
can not assign individual measurements to individual targets 
in an apriori manner 

Given the large number of applications, algorithms for 
filtering problems with data association uncertainty have 
been extensively studied in the past; cf., [1], [10] and 
references therein. A typical algorithm is comprised of two 
parts: 

(i) A filtering algorithm for tracking a single target, and 

(ii) A data association algorithm for associating measure- 
ments to targets. 

Prior to mid-1990s, the primary tool for filtering was a 
Kabnan filter or one of its extensions, e.g., extended Kalman 
filter The limitations of these tools in applications arise on 
account of nonlinearities, not only in dynamic motion of 
targets (e.g., drag forces in ballistic targets) but also in the 
measurement models (e.g., range or bearing). The nonlin- 
earities can lead to a non-Gaussian multimodal conditional 
distribution. For such cases, Kalman and extended Kalman 
filters are known to perform poorly; cf., [15]. Since the 
advent and wide-spread use of particle filters [7], [6], such 
filters are becoming increasing relevant to single and multiple 
target tracking applications; cf., [15] and references therein. 
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The other part is the data association algorithm. The 
purpose of the data association algorithm is to assign mea- 
surements to targets. The complications arise due to multiple 
non-target specific measurements (due to multiple targets in 
the coverage area), missing measurements (probability of 
detection less than one, e.g., due to target occlusion), false 
alarms (due to clutter) and apriori unknown number of targets 
(that require track initiation). 

The earlier solutions considered assignments in a deter- 
ministic manner: These include the simple but non-robust 
"nearest neighbor" assignment algorithm and the multiple 
hypothesis testing (MHT) algorithm, requiring exhaustive 
enumeration [14], [3]. However, exhaustive enumeration 
leads to an NP-hard problem because number of associations 
increases exponentially with time. 

The complexity issue led to development of probabilistic 
approaches: These include the probabilistic MHT or its sim- 
pler "single-scan" version, the joint probabilistic data associ- 
ation filter (JPDAF) [10], [2]. The central object of interest 
in these approaches is the computation (or approximation) 
of the measurement-to-target association probability. Certain 
modeling assumptions are necessary to compute these in a 
tractable fashion. Although the probabilistic algorithms have 
reduced computational complexity, they have primarily been 
developed for linear settings; cf., [1]. 

The development of particle filters has naturally led to 
investigations of data association algorithms based on im- 
portance sampling techniques. This remains an active area of 
research; cf., [11] and references therein. One early contribu- 
tion is the multi target particle filter (MPFT) in [8]. The data 
association problem is approached in the same probabilistic 
spirit as the basic JPDAF. The association probabilities are 
obtained via the use of Markov Chain Monte-Carlo (MCMC) 
techniques; see also [12], [13] for related approaches. 

In this paper, we introduce a novel feedback control-based 
particle filter algorithm for solution of the joint filtering -data 
association problem. The proposed algorithm is based on the 
feedback particle filter concept introduced by us in earlier 
papers [17], [16]. A feedback particle filter is a controlled 
system to approximate the solution of the nonlinear filtering 
problem. The filter has a feedback structure similar to the 
Kalman filter: At each time t, the control is obtained by 
using a proportional gain feedback with respect to a certain 
modified form of the innovation error The filter design 
amounts to design of the proportional gain - the solution 
is given by the Kalman gain in the linear Gaussian case. 

In the present paper, we extend the feedback particle 
filter to problems with data association uncertainty. We refer 



to the resulting algorithm as the joint probabilistic data 
association-feedback particle filter (JPDA-FPF). As the name 
suggests, the proposed algorithm represents a generalization 
of the Kalman filter-based joint probabilistic data association 
(JPDAF) now to the general nonlinear filtering problem. 

One remarkable conclusion of our paper is that the JPDA- 
FPF retains the innovation error-based feedback structure 
even for the nonlinear problem. The innovation error-based 
feedback structure is expected to be useful because of the 
coupled nature of filtering and the data association problems. 

The theoretical results are illustrated with two numerical 
examples. The first example considers the problem of track- 
ing a single target in the presence of clutter. The second 
example considers a multiple target tracking problem. The 
model problem scenario is used to illustrate the performance 
of JPDA-FPF vis-a-vis possible track coalescence in the 
presence of data association uncertainty [4]. 

The outline of this paper is as follows: The JPDA-FPF 
algorithm is first described for single target in the presence 
of clutter, in Sec. The multiple target case follows as 
a direct extension, and is discussed in Sec. Numerical 
examples appear in Sec. IIVI 

The theory of feedback particle filter can be found in 
our earlier papers [17], [16]. In the remainder of this paper, 
we restrict ourselves to the scalar filtering problem. The 
scalar case serves the pedagogical purpose, and is notation- 
ally convenient. The extension to the multivariable case is 
straightforward: The feedback particle filter has the same 
innovation error-based structure except that the gain function 
is replaced by the gain vector The multivariable feedback 
particle filter is used in the two numerical examples described 
in Sec. |IV] 

II. Feedback Particle Filter with Data 
Association Uncertainty 

In this section, we describe the probabilistic data 
association-feedback particle filter (PDA-FPF) for the prob- 
lem of filtering a single target with multiple measurements. 
The filter for multiple independent targets is obtained as a 
straightforward extension, and briefly described in Sec. mi 

A. Problem statement. Assumptions and Notation 
The following notation is adopted: 

(i) At time f, the target state is denoted by Xt E K. 

(ii) At time f, the observation vector Z, 

{Z} , . . . ,Zf^Y , where M is assumed fixed and 

z™ e M. 

(iii) At time f , the association random variable is denoted as 
At e {0, 1 , . . . ,M}. It is used to associate one measurement 
to the target: At —m signifies that the m*-measurement Z,™ 
is 'associated' with the target, and At =0 means that the 
target is not detected at time f. 

The following models are assumed for the three stochastic 
processes: 

(i) The state Xt evolves according to a nonlinear SDE: 



where «(•) is a function and {Bt} is a standard Wiener 
process. 

(ii) The association random process A, evolves as a jump 
Markov process in continuous-time: 

P{At+s^m'\At^m) = ^5 + o{d), wl^^m. (2) 

The initial distribution P([Ao = m]) = -g^. A, and Xt are 
assumed to be mutually independent. 

(iii) At time f, the observation model is given by, 

= \\A,=,n\K^t)At + CTwdW/", (3) 

for me {1,...,M}, where h{-) is function and {W/"} 
are mutually independent standard Wiener processes and 



l[A,=m] 



1 when At — m 
otherwise. 



The problem is to obtain the posterior distribution of Xt 
given the history of observations ^ := <7(Z^ : s <t). 
The methodology comprises of the following two parts: 

(i) Evaluation of association probability, and 

(ii) Integration of association probability in the feedback 
particle filter framework. 

B. Association Probability for a Single Target 

The association probability is defined as the probability of 
the association [At =m] conditioned on ^: 

i8,"' = P([A, =m]|^), m = 0,l,...,M. (4) 

Since the events are mutually exclusive and exhaustive. 

For the single-target-multiple-observation model described 
above, the filter for computing association probability is 
derived in Appendix |A] It is of the following form: For 
m e {1,...,M}, 

di3;" = -^[l-(M+l)r] dt 

1 M 

+ —prk L pt' ( dzr - pt'"ht df ) - ( dz/ - pt'ht dt) 



M 



-A'"(/z?-/?)^A^(A^-r)df, 



(5) 



dXt^a{Xt)dt + aBdBt, 



(1) 



where h, = £[h{Xt)\S't] and = £[h^{Xt)\S't]- These are 
approximated by using the feedback particle filter described 
in the following section. 

In practice, one may also wish to consider approaches to 
reduce filter complexity, e.g., by assigning gating regions for 
the measurements; cf.. Sec. 4.2.3 in [2]. 

Remark 1: In the following, we integrate association 
probability with the feedback particle filter, which is used to 
approximate evolution of the posterior Separate algorithms 
for data association and posterior are motivated in part 
by the classical JPDA filtering Hterature [2], [1], [10]. A 
separate treatment is also useful while considering multiple 
target tracking problems. For such problems, one can extend 
algorithms for data association in a straightforward manner, 



while the algorithm for posterior remains as before. This is 
illustrated with the aid of two-target-two-observation exam- 
ple in Sec 

Remark 2: The association probability filter (|5) can also 
be derived by considering a continuous-time limit starting 
from the continuous-discrete time filter in literature [2]. This 
proof appears in Appendix iDl The alternate proof is included 
for the following reasons: 

(i) The proof shows that the filter (|5} is in fact the 
continuous-time nonlinear counterpart of the algorithm 
that is used to obtain association probability in the classical 
JPDAF filter This is important because some of the 
modeling assumptions (e.g., modeling of clutter, or of 
association A, via a jump Markov process) here may ap- 
pear to be different from those considered in the classical 
literature. 

(ii) The proof method suggests alternate discrete-time al- 
gorithms for evaluating association probabilities in simu- 
lations and experiments, where observations are made at 
discrete sampling times. 

C. Probabilistic Data Association-Feedback Particle Filter 

Following the feedback particle filter methodology, the 
model for the particle filter is given by, 

dx; = a{Xi) At + ObABI + dt//, (6) 

where X,' G M is the state for the /* particle at time f, 
U'f is its control input, and {BJ} are mutually independent 
standard Wiener processes. We assume the initial conditions 
{Xq}^[ are i.i.d., independent of {BJ}, and drawn from the 
initial distribution p*{x,Q) of Xq. Both {B\} and {Xq} are 
also assumed to be independent of Xt,Zt. Certain additional 
assumptions are made regarding admissible forms of control 
input (see [16]). 

Recall that there are two types of conditional distributions 
of interest in our analysis: 

(i) p{x,t): Defines the conditional dist. of X,' given Sfg . 

(ii) p*{x,t): Defines the conditional dist. of Xt given jF, . 

The control problem is to choose the control input f/,' 
so that p approximates p*, and consequently empirical 
distribution of the particles approximates p* for large number 
of particles. 

The evolution of p*{x,t) is described by modified form of 
the Kushner-Stratonovich (K-S) equation: 

1 M 

dp* = i^Vdf + — £ j3;"(/i-/ir)(dz;"-^,df)p*. (7) 

m=\ 

where ht — J h{x)p* {x,t)dx, and is the Kolmogorov 
forward operator The proof appears in Appendix E] 

The main result of this section is to describe an explicit 
formula for the optimal control input, and demonstrate that 
under general conditions we obtain an exact match: p = p* 
under optimal control. The optimally controlled dynamics of 



the / particle have the following form, 

M 

dx; = fl(x/)df+f7BdB; + £ p;"K{x,\t)dii'"' 

m=l 
i M 

+ 2^^I(A'")'K(^/,0K'(X,V)df, (8) 

m=l 

where is a modified form of the innovation process, 

Qm Qm 

dr' := dzr ~ [\h{xi) + (1 - df , (9) 

where ht :— E[h{Xt)\3ft] = J h{x)p{x,t)dx. The gain function 
K is the solution of a certain EL-BVP: 

The evolution of p{x,t) is easily obtained as the forward 
Kolmogorov operator: See Appendix iBl for the equations. 

The following theorem shows that the two evolution 
equations for p and p* are identical. The proof appears in 
Appendix |B] 

Theorem 1: Consider the two evolutions for p and p*, 
defined according to the Kolmogorov forward equation and 
modified K-S equation O, respectively. Suppose that the 
gain function K(X,f) is obtained according to ( fTOl l. Then 
provided p(x,0) = p*{x,Q), we have for all f < 0, p{x,t) = 

p*{x,t). m 

Example 1: Consider the single target, single measure- 
ment case where the measurement may be due to clutter 
(false alarm). Let j3, denote the measurement-to-target asso- 
ciation probability at time f. 

For this case, the feedback particle filter is given by the 
controlled system which is a special case of (HJl, 

dX; =a{xi)dt + aBdBl 

+ l5Mxi,t)di; + ^l5^a^Kixi,t)K'{x;,t)dt, (11) 

where the innovation error // is given by, 

dli := dZ, - (^^h{Xi) + (1 - |)/;^ dt. (12) 

For the two extreme values of j3,, the filter reduces to the 
known form: 

(i) If /3r = 1, the measurement is associated with the target 
with probability 1. In this case, the filter is the same as 
FPF presented in [16]. 

(ii) If j3r = 0, the measurement carries no information and 
the control input dt// = 0. 

For j5t e (0, 1), the control is more interesting. The remark- 
able fact is that the innovation error-based feedback control 
structure is preserved. The association probability serves to 
modify the formulae for the gain function and the innovation 
error: 

(i) The gain function is effectively reduced to j3,K(X/,f). 
That is, the control gets less agressive in the presence of 
possible false alarms due to clutter. 



(ii) The innovation error is given by a more general for- 
mula ( fT2] i. The optimal prediction of the /* -particle is now 
a weighted average of h{X,') and the population prediction 
ht « Tjll%ih{X{). Effectively, in the presence of possible 
false alarms, a particle gives more weight to the population 
in computing its innovation error. 

D. Example: Linear Case 

We provide here a special case of PDA-FPF for the single 
target tracking problem described by a linear model: 



dX, = aX,df + c7BdB(, 
dZ, = yXtdt + UwAW,, 



(13a) 
(13b) 



where a,y are real numbers. 

The PDA-FPF is described by dSTl-lfTOb. If we assume 
p{x,t) to be Gaussian at each time with mean jU, and 
variance Z,, i.e., p{x,t) = -^=L=exp(— ^^^^^^), then by direct 
substitution in (fTOl l we obtain the gain function: 



K(x,f)-^. 



(14) 



The PDA-FPF is then given by, 
dx; ^aXldt + GBdBi 

dz; 



§LA'" 



-"W m=l 



am am 

ri^x; + {i-^)^,)dt 



(15) 



The filter for association probability j3/" is as follows: 



dj3;« = ^[l-(M+l)r] df 

, M 



■'W 



7=1 
M 



r 7Mr E A' (dzr - dt) - (dZ/ - A'7Ai, df ) 



+ ■ 



1 m 



(16) 



In practice {/x,,E,} in ([Tsll-lfTSIl are approximated as 
sample means and sample covariances using {X/}^]. 



1 



(17) 



E,«Ef):= 



^ (=1 



III. Multiple Target Tracking using 
Feedback Particle Filter 

In this section, we extend the PDA-FPF to multiple target 
tracking problems. Specifically, a two-target two-observation 
problem is used to illustrate JPDA-FPF. The extension to the 
more general case is straightforward. 



A. Problem statement 

The following notation is adopted: 
(i) At time t, the target state is denoted as X, := {X} jX^Y , 

^^'^^ , where 



where X',' e M for « e {1,2}. 

(ii) At time /, the observation vector Z, 
Zf eRform€{l,2}. 

(iii) At time f , the association random variable is denoted as 
A, e {1,2}. It is used to associate measurements to targets 
in a joint manner: At signifies that Z} is associated with 
target 1 and Zj with target 2. Similarly At —2 accounts 
for the complementary case. 

The following models are assumed for the three stochastic 
processes: 

(i) Each element of the state vector X^ evolves according 
to a one-dimensional nonlinear SDE: 



dX," = fl(X,")df + a^'dB;', ne{l,2} 



(18) 



where {B]},{Bj} are mutually independent standard 
Wiener processes, 
(ii) The association random process A, evolves as a jump 
Markov process in continuous-time: 

P(A,+5 m'\At = m) = c5 + o(5), m' ^ m. (19) 



The initial distribution P([Ao = m]) = j. A, and X^ are 
assumed to be mutually independent, 
(iii) At time f, the observation model is given by. 



dZ/ 
dZ? 



:^(A,) 



h{X}) 
h{Xf) 



df + ffiy 



dW/ 
dW? 



(20) 



where {VV/},{W/} are mutually independent standard 
Wiener processes and ^(A,) is a function which maps 
At to a permutation matrix: 



1 
1 



^(2) = 



1 

1 



(21) 



B. Joint Probabilistic Data Association for Two Target 

The joint association probability is defined as the proba- 
bility of the joint association [A, = m] conditioned on S^: 



<' = P([A,=m]|^ 



1,2. 



(22) 



The filter for joint association probability Kt is a straight- 
forward extension of (|5]l. The proof appears in Appendix O 
It is of the following form: 



dTT/ = -C« - Kt)dt + -^KlKf{h]-hi){dlll - diif) 



\\2 



■'W 



(23) 



where d^/« = dZ," - [n} - n})h]"dt, h'f := E[h{X^)\^] and 



n\2 



E[h {X")\^]. Since the joint events are mutually 



exclusive and exhaustive, we have i TT"' = 1. Using this, 
we have = 1 — n} and dnf — — dn} . 




□ Clutter 

— Tmetraj. 

Target-oriented meas. 

Esttraj. 



Fig. 1. Simulation results of single target tracking in clutter using PDA- 
FPF: Comparison of estimated mean with the true trajectory. 



C. Joint Prob. Data Association-Feedback Particle Filter 

The joint association probabilities tt/ , are used to obtain 
marginal association probability for individual target. For 
example, for target 1: )3/ = Ttf, fi} = k}. Once the association 
probabilities are known, the feedback particle filter for each 
target is of the form (|8). 

IV. Numerics 

In this section, we discuss results of two numerical exam- 
ples. Even though the theory was described for real-valued 
state and observation processes, the numerical examples 
consider more realistic multivariable models. 

A. Single Target Tracking in Clutter 

We first consider a single target tracking problem where 
the target dynamics evolve according to a white-noise accel- 
eration model; 



AX,=FX,dt + aBdB,, 
AZ,=HX,At + OwAWt, 



(24) 
(25) 



where Xt denotes the state vector comprising of position and 
velocity coordinates at time f, Zf is the observation process, 
{B(},{VKr} are mutually independent standard Wiener pro- 
cesses. The two matrices are given by: 



1 




, H=[l 0] 



(26) 



In the simulation results described next, we use the fol- 
lowing parameter values: Ob = [0; 1], C% — 0.06 and initial 
condition Xq = [0; 6] . The total simulation time is T 1 and 
time step dt = 0.01. At each discrete-time step, we assume 
M = 4 measurements, one due to target and other three due 
to clutter The associations are not apriori known. 

Figure [T] depicts the result of a single simulation: True 
target trajectory is depicted as a dashed line. At each dis- 
crete time step, target-oriented measurements are depicted as 
circles while clutter measurements are depicted as squares. 
The estimated mean trajectory is depicted as a solid line. It is 
obtained using the PDA-FPF algorithm described in Sec ^ 
D. For the filter simulation, we use — 1000 particles. 



B. Track Coalescence Avoidance using JPDA-FPF 

Track coalescence is a common problem in multiple 
tracking applications. Track coalescence can occur when two 
closely spaced targets move with approximately the same ve- 
locity over a time period [3]. With standard implementations 
of JPDAF and SIR particle filter algorithms, the target tracks 
tends to coalesce even after the targets have moved apart [4] . 
In the following example, we describe simulation results for 
JPDA-FPF for a model problem scenario taken from [5]. 

We consider two targets. For each target, the dynamics 
are described by a white-noise acceleration model as in the 
preceding example. For n = 1,2: 



dX," =fX,"df + C7BdBf, 



(27) 



where the state xp comprises of target position and velocity. 
We assume two observations are given by 



dZ/ 
dZ? 



HX,^ 
HX} 



dt + Ow 



dW/ 
dW^ 



(28) 



where At is the association random variable, ^(A,) is the 
permutation matrix as defined in (ISTT l. {B,},{W/},{W,'^} are 
mutually independent standard Winer processes. 

In the simulation results described next, we use the fol- 
lowing parameter values: Og = [0;2], Ow = [0.005; 0.005] and 
initial condition Xq — [1;— 3.5; — 1;3.5]. The total simulation 
time is r = li and time step df = O.OOli. The prior associ- 
ation probability [n} ,nf) is assumed to be (1/2,1/2). 

Figure |2ja) depicts the results of a single simulation: The 
estimated mean trajectories are obtained using the JPDA- 
FPF described in Sec|IIIl Figure |2b) depicts the evolution of 
association probability {k} ,nf) during the same simulation 
run. For the filter simulation, we use = 1000 particles. 
To obtain the association probabilities, we use an adaptive 
time stepping scheme for numerical integration of association 
probability filter (l23T l. 
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Appendix 
A. Association Probability Filter for j3/" 
Rewrite (O in the vector form: 

dZ, = x{A,)h{Xt)dt + GwdW,, (29) 

where x{A,) := {x},-,xfY. XT = 1[A,=„,]' ^nd W, : = 
{Wf^ , ...,W/^Y . The transition intensity matrix for the jump 
Markov process A, is denoted as A with 



— c if m = m' 
c/M if m 7^ m' . 



(30) 



Denote .% := a{X, ■.s<t), and The derivation 

is based on the property of the conditional expectation: 

E[(p(A,)|i^] = E[E[(p(A, 




Fig. 2. Track coalescence avoiding using JPDA-FPF: (a) Comparison of estimated mean JPDA-FPF witli trae trajectories, (b) Plot of data association 
probability. 



The SDE for evolution of E[9(A,)|'^,] is described by the 
standard Wonham filter: 

E[(p{A,)\%] = E[(p(Ao)]+ f E[A(p{A,,)\%]ds 



The evolution equation for p now follows 

-2 M 
'W_ Y 



D rrl M -)2 

dp = ^'pdt--(up)dt + ^Y. (A")'^ (P^^) 

7=1 



M 



£ / E[(Dr-Kx,)r/)£(^)i'^.](dzr-/.(x,)Ard^), 



(M^A'-dzr 

m=l 



dx 



(33) 



(31) 



where / is the identity matrix, Df is the diagonal matrix 
where the only non-zero entry is (Z)J")„,„, — h{X,). 
Taking E.[-\3ft] of (l3l1 l gives the desired result (|5j. 

B. Consistency proof of p and p* 

Evolution equation for p*: Recall 3ff := gfZ^ : ^ < f ), jz^ : = 

(7(A, : 5 < f)- We denote 'i', := V^. The derivation is 
based on the property of the conditional expectation: 

E[(p{X,)\^]^E[E[(p{X,)\%]m. 

The sde for evolution of E[(p(Xf ) j"^,] is described by the stan- 
dard nonlinear filter with innovation error, Lm=i Zr"(d-Z™ — 
h,dt), where xr^'^[A,=m]- 

E[(piXr)\%] = E[(piXo)] + f E[^(p{X,,)\'^,]ds 
Jo 



Proof of consistency. The proof follows closely the consis- 
tency proof for the feedback particle filter (see Appendix C 
in [16]). If K solves the E-L BVP then 



l.iKp) = ^{h-k)p 



(34) 



On multiplying both sides of ( |32] | by ~p and simplifying 
(by using (l34li). we obtain 



ln= 1 m= 1 



Differentiate now both sides with respect to x and use ( l34l l 
once again to arrive at 



-2 M 



-1 



M 



(35) 



E /' E[(/; — ^i)^(Xi)|'^^(];^"'(dZ'." — /ijdi) Using ( |34] | and ( |35] | in the forward equation (|33), we obtain: 

1 M 

d/? = ^ V df + — E A'" - ( dZr - /^r df)/? (36) 



m=l 

where ^ denotes the Kolmogorov's backward operator for 
the diffusion ([B (the adjoint of ^^). 

Taking E[-\^] gives the desired result because 
E[zri^] = P([A.v = m]|C,)=r- 
Evolution equation for p: We express the FPF (O as: 

M 

dX/ = a(x;)df + (TBdB; + K(X/,f) £ jS/'MZ™ + M(x/,f)df, 



where 



M 



«(x,f):=-EA'" 



m= 1 



K(.x,0 



■^2 M 



£(/3;")2KK'(x,f) 



7=1 



This is precisely the SDE (|7]i, as desired. 

C. Association Probability filter for TT™ 

The derivation follows closely the derivation in Ap- 
pendix |A] Note that the observation model is de- 
scribed by (EOll. Denote h{X,) := [h{X})M^I)Y^ % ■ = 
Zi=i ?rf"I'(m) and ^ = (0/ , 0,2)^ := The Wonham 

filter is given by: 

E[(piA,)\%] = E[(p(Ao)]+ /''E[A(p(A,)|<^.]di 
— — Jo — 

(32) +E rE[(D';'-</);7)<p(^-)l^v](dz;"-0;'d.), o?) 



where D'" is a 2 x 2 diagonal matrix where {D'")ii is the 
entry of the vector ^{i)h{Xj)- 

Taking E[-| JfJ] of (|37] | gives the desired result. 

D. Alternate Derivation of (|5]l 

The aim of this section is to derive, formally, the update 
part of the continuous time filter (|5) by taking a continuous 
time limit of the discrete-time algorithm for evaluation of 
association probability. The procedure for taking the limit is 
similar to Sec 6.8 in [9] for derivation of the K-S equation. 

At time f, we have M measurements dZ, = 
(dZ/, dZf, dZf^Y , only one of which originates from the 
target. The discrete-time filter for association probability is 
obtained by using Bayes' rule (see [2]): 

P(dZ,|[A, =m])P([A, ==m]|^) 



P([A,=m]|^,dZ,): 



IjLiP(dZ,|[A,^j])P([A,=j]|^ 



(38) 

In evaluation of the association probability, one typically 
assumes a clutter model whereby the independent measure- 
ments are uniformly and independently distributed in the 
coverage area V ([2],[1]). We then have: 

P(dZ,|[A, = m]) = yi-^P(dZr|[A, - m]) 



= V 



l-M 



where L(dZ;") 



Now, denote j3/" = P([A, 



/Rexp 



L(dZr). 

(dZ'p-h(x)dtf 



(39) 
p{x^t)dx. 



S,), the increment in the 



measurement update step (see Sec 6.8 in [9]) is given by 

d)3,"' P([A, = m]|^, dZ,) - P([A, = m]\^). (40) 
Using (|38] | and (l40b . we have: 

dft'"=£"'(dr,dZ,)/3/"-j3,"', 

where 

E"'{At,dZ,) 



(41) 



P([A, =m]|X,dZ, 



(42) 



P([A,=m]|^) ■ 
We expand E"'{dt, dZ,) as a multivariate series about (0,0): 



M 



£'"(df,dZ,) =£'"(0,0) +£3^(0,0) df+ ££';^,(0,0)dZ/ 

(43) 



1 M 

- y E" 

9 ^ d 



2 ^ ""dZ/.dZf 
^ j,k=l ' • 



(0,0)dZ/dzf + o(df) 



By direct evaluation, we obtain: 

£'"(0,0) = 1, £'£(0,0) =0, 

n.(0.0)--^/3/i,iV'« 



dZ/ 



£J,'«(0,0) = -^(1-A"%, 



"dZ/,dZ/ 



"dZ;".dZ! 



,(0,0) 



-(i-r)(i-2A'>?, 



where h := E[/j(X,)|^] and h} := ^{h^{Xt)\^\. 



By using Ito's rules, 
dz/dZf = 

This gives 

£'"(df,dZ,) = 



0, 



if j =k, 
otherwise. 



M 



-/';,^j3/(dz;"-dz/) 



1 



M 



hjJ^I5/il5/-Pr)dt, (44) 

Substituting ( l44b to ( |4TI ) we otain the expression for d/3/" 
which equals the measurement update part of the continuous- 
time filter (|5]l. 

Remark 3: During a discrete-time implementation, one 
can use (|38])-(|39]) to obtain association probability. In ( |38] ), 
L(dZ"') is approximated by using particles: 



L(dz;"): 



1 



1 



iTza^dt 1=1 



N 

^exp 



{dZ';-h(Xl)dt 



\2l 



2a^dt 
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